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[ 特許 請求 の 範囲 】 
【 請求 項 1 】 

少な く と も 1 つの 運動 連鎖 を 含む 運動 連鎖 構造 を 有する ロボ ッ ト (1) の 衝突 処理 方 法 
で あり 、 前 記 運 動 連鎖 構造 は せ 、 ベー ス 、 リ ンク 、 リ ンク を 接続 する 関節 、 ア クチ ュ エ ー タ 
お よび 少な く と も 1 つの エン ド エ フ ェ ク タ 、 カ トル ク を 測定 推定 する た め 少 な く と も 
1 つの 前 記 運 動 連 鎖 の 最も 遠 位 の リン ク に ある セン サ Suis /、 お よび 固有 受容 デー タ を 
測定 推定 する た め の セ ン サ 5 で 構成 され 、 前 記 セ ン サ る は 、 前 記 運 動 連鎖 構造 に 沿っ 
て 任意 に 配置 され 、 こ の 方 法 は 

- 前 記 ロ ボッ ト (1) の ダイ ナミ クス を 記述 する モデ ル を 提供 (S 1) し 、 

- 少な く と も 1 つの 前 記 運 動 連鎖 の 最も 遠 位 の リン ク に お いて 、 セ モ センサ Saisia / に より 
JL bUVZ Fort saitai を 測定 お よび また は 推定 (S 2) L. 

- 前 記 セ ン サ % に より 固有 受容 デー タ : ベー ス お よび ロボ ッ ト の 一 般 化 座標 7( ひ 0 お よ 
びそ れ ら の 時 間 微 分 9(D り 、 一 般 化 関節 モー ター カ て 。、 外 力 上 、 ベ ー ス 方 位 ps(D り お よび ベー 
ス 速度 *(D ぉ 。、 を 測定 お よび また は 推定 (S 3) L. 

- 前 記 固 有 受 容 デ タ お よび モデ ル の 少な く と も 1 つ に 基づい て 、 運 動 量 オプ ブザー バ 

(3) に より 一 般 化 外 力 て 。。: の 推定 値 そ を 生成 (S 4) L. 

= 人 基づい て 、 ベ ー ス お よび ロボ ッ ト の 一 般 化 座標 9 が ( り の 2 次 導 関 数 の 推定 
値 9 の を 生成 (S 5) L. 

- #0 に 基づい て 、 前 記 運 動 連鎖 構造 上 の 点 の の デカ ルト 加速 度 久 を 推定 (S 6) L. 

- 推定 外部 レン チル を 取得 する た め 、 る に 基づく 剛体 力学 効果 お よび 重力 効果 に 対 
し て 太 を 補正 (S 7) L. 

- 予期 し な い 衝 突 か ら 生 じ る 一 般 化 関節 力 の 推定 。。。 を 取得 する た め 、 ヤ コ ビ ア ン 
た aar 変換 きれ た ん 4sasker に 対 し て も を 補正 (S 8) L. 

Text, col > Tthresn 3 + Os = た ( RH Eu si > Fs ithresh@ Z €T , 与え られ た 関 値 て みお + が 
eitmresh に 基づい て 衝突 を 検出 (S 9) する 、 

AP LY eat. WE. 


[ 请 求 项 2 ] 
推定 外部 レン チル a E MET 2 Te b. FAV KIRE ICE < HUK 5329 3 k Oš 
重力 効果 に 対し て 前 記 外 力 広 を 補正 する た め の 補 正 レ ンチ は 、 複 数 の セン サ 々 が 関節 また 
は リン ク の いずれ か に 接続 され て いる 場合 に 再帰 的 に 生成 され る 、 請 求 項 1 に 記載 の 方 法 。 
【 請求 項 3 】 

> Rc d CR NU 
線 と 前 記 運 動 連 鎖 構造 の ジオ メト リ を 交差 させ る こと で 、 前 記 運 動 連 鎖 構造 と の 衝突 の 接 
触 位置 を 決定 (S 10) する ステ ッ プ 、 を 更に 含む 、 請 求 項 1 また は 請求 項 2 の いずれ 
か 一 項 に 記載 の 方 法 。 


【 請求 項 4 】 

- 決定 され た 前 記 接 触 位置 を ヶ に 基づい て 、 完 全 な 接触 ヤ コ ビ アン ル た ,= ル 記 を 決定 (S 
133 ba 

- IBLF: Fhear Fan). = (HE JE Text co を 決定 (S12) する ステ ッ プ 、 を 
更に 含む 、 請 求 項 3 に 記載 の 方 法 。 


【 請求 項 5】 
お よび (Fer Koen) に 依存 する 前 記 ロ ボッ ト (1) を 制御 (S 1 3) する 、 請 求 


项 2 て 請求 項 4 の いずれ か 一 項 に 記載 の 方 法 。 


[ 請求 項 6 】 
前 記 ロ ボッ ト ( 1 ) は ヒュ ー マ ノ イド ロボ ッ ト で ある 、 請 求 項 1 一 请 求 项 5 の いずれ か 
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ー 項 に 記載 の 方 法 。 

【 請求 項 7 】 

デー タ 処 理 ユ ニッ ト を 備え た コン ピュ ー タ シス テム で あっ て 、 前 記 デ ー タ 処理 ユニ ッ ト 
は 、 請 求 項 1 一 请求 项 6 の いずれ か 一 項 に 記載 の 方 法 を 実行 する よう に 設計 お よび 設定 さ 
れる 、 コ ンピュータ シス テム 。 

【 請求 項 8 ] 

制御 信号 は 、 プ ログ ラム 可能 な コン ピュ ー タ シス テム と 共 働 す る こと が で き 、 そ れ に よ 
り 、 請 求 項 1 ~ 請 求 項 7 の いずれ か 一 項 に 記載 の 方 法 を 実行 する こと が で きる 、 電子 的 に 
読み 取り 可能 な 前 記 制 御 信 号 を 備え た デジ タル デー タス トレ ー ジ 。 

【 請求 項 9 】 

プロ グラ ムコ ー ド が コン ピュ ー タ シス テム 上 で 実行 され る 場合 、 請 求 項 1 請求 項 8 の 
いずれ か 一 項 に 記載 の 方 法 を 実行 する た め の 機 械 可 読 媒体 に 格納 され た 前 記 プ ログ ラム コ 
ー ド を 含む お コンピュー タプ ログ ラム プロ ダク ト 。 

【 請求 項 1 0 】 

ンピュータ プロ グラ ム が コン ピュ ー タ シス テム 上 で 実行 され る 場合 、 請 求 項 1 一 请 求 
项 9 の いずれ か 一 項 に 記載 の 方 法 を 実行 する た め の プ ログ ラム コー ド を 有する コン ピュ ー 
タプ ログ ラム 。 

【 請求 項 1 1 】 

少な く と も 1 つの 運動 連鎖 を 含む 運動 連鎖 構造 を 有 す す る ロボ ッ ト (1) で あり 、 前 記 運 
動 連 鎖 構 造 は 、 ベー ス 、 リ ンク 、 リ ンク を 接続 する 関節 、 ア クチ ュ エ ー タ 、 お よび 少な く 
と も 1 つの エン ド エ フ ェ ク タ 、 カ トル ク を 測定 推定 する た め 、 少 な く と も 1 つの 前 記 
運動 連鎖 の 最速 位 リン ク に ある セン サ Sasa s. お よび 固有 受容 デー eas 
NINE OM te 前 記 セ ン サ ぶ , は 前 記 運 動 連鎖 構造 に 沿っ て 任意 に 配置 され 、 
前 記 ロ ボッ ト (1) は 請求 項 1 ~F Pan c I mana amir 
に 設計 お よび 設 a ロボ ッ ト (1). 


m 


[ 請求 項 1 2】 

前 記 ロ ボッ ト ( 1 ) は 、 デ ー タ ネッ トワ ー ク と の デー タイ ンタ ー フ ェ ー ス を 備え 、 前 記 
ロボ ッ ト ( 1 ) は 、 前 記 デ ー タ ネッ トワ ー ク か ら 前 記 ロ ボッ ト ( 1 ) を 設定 お よび 制御 す 
る た め の シ ステ ム プ ログ ラム を ダウ ン ロ ー ド する よう に 設計 お よび 設定 され る 、 請 求 項 1 
1 に 記載 の ロボ ッ ト ( 1 ) 。 

【 請求 項 1 3 】 

前 記 ロ ボッ ト ( 1 ) は 、 前 記 デ ー タ ネッ トワ ー ク か ら 前 記 シ ステ ム プ ログ ラム の パラ メ 
ー タ を ダウ ン ロ ー ド する よう に 設計 お よび 設定 され る 、 請 求 項 1 1 また は 請求 項 1 2 の い 
ずれ か 一 項 に 記載 の ロボ ッ ト ( 1 ) 。 

【 請求 項 1 4 】 

前 記 ロ ボッ ト ( 1 ) は 、 ロ ー カ ル 入 カカ インター フェ ー ス お よび ググ ま た は ティ ーー チイ ンプ 
ロ セ ス を 介し て 前 記 シ ステ ム プ ログ ラム の パラ メー タ を 入力 する よう に 設計 お よび 設定 さ 
れ 、 前 記 ロ ボッ ト ( 1 ) は 手動 で 誘導 され る 、 請 求 項 11 一 请 求 项 1 3 の いずれ か 一 項 に 
記載 の ロボ ッ ト ( 1 ) 。 

【 請求 項 1 5] 

前 記 ロ ボッ ト ( 1 ) は 、 前 記 デ ー タ ネッ トワ ー ク か ら の シス テム プロ グラ ム お よび / ま 
た は それ ぞ れ の パラ メー タ の ダウ ン ロ ー ド が 遠隔 基地 に よっ て 制御 され る よう に 設計 お よ 
び 設 定 さ れ 、 前 記 遠 隔 基地 は 前 記 デ ー タ ネッ トワ ー ク の 一 部 で ある 、 請 求 項 1 1 請求 項 
1 4 の いずれ か 一 項 に 記載 の ロボ ッ ト ( 1 ) 。 

【 請求 項 1 6】 

前 記 ロ ボッ ト ( 1 ) は 、 前 記 ロ ボッ ト ( 1 ) で ロー カル に 利用 可能 な シス テム プロ グラ 
ム お よび ププ また は それ ぞ れ の パラ メー タ が 、 前 記 デ ー タ ネッ トワ ー ク か ら 受 信 し た それ ぞ 
れ の 要求 に 基づい て デー タネ ットワーク の 1 人 以上 の 参加 者 に 送信 され る よう に 設計 お よ 
び 設 定 さ れる 、 請 求 項 1 1 ~ 請 求 項 15 の いずれ か 一 項 に 記載 の ロボ ッ ト (1 ) 。 
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請求 項 1 7 】 

前 記 ロ ボッ ト ( 1 ) は 、 前 記 ロ ボッ ト ( 1 ) で ロー カル に 利用 可能 な それ ぞ れ の パラ メ 
ー タ を 有する シス テム プロ グラ ム が 遠隔 基地 か ら 開 始 で きる よう に 設計 お よび 設定 され 、 
前 記 遠 隔 基 地 は 前 記 デ ー タ ネッ トワ ー ク の 一 部 で ある 、 請 求 項 1 1 ~ 请 求 项 1 6 の いずれ 
か 一 項 に 記載 の ロボ ッ ト ( 1 ) 。 

【 請求 項 1 8】 

前 記 ロ ボッ ト ( 1 ) は 、 前 記 遠 隔 基 地 お よび ププ また は 前 記 ロ ー カ ル 入 力 イ ンタ ー フ ェ ー 
ス が 、 シ ステ ム プ ログ ラム お よび それ ぞ れ の パラ メー タ の 入力 の た め お よ び プ また は 多数 
の シス テム プロ グラ ム と それ ぞ れ の パラ メー タ か ら シ ステ ム プ ログ ラム と それ ぞ れ の パラ 
メー タ を 選択 する た め に 設計 お よび 設定 され た ヒュ ー マ ン マシ ン イ ンタ ター フェー ス H MI 
を 含む よう に 設計 お よび 設定 され る 、 請 求 項 1 1 一 請求 項 1 7 の いずれ か 一 項 に 記載 の ロ 
Fs F (1). 

[ 請求 項 1 9】 

前 記 ヒ ュー マン マシ ン イ ンタ ー フ ェ ー ス HMI は 、 タ ッ チ スク リー ン で の 「 ド ラッ グ ア 
ンド ドロ ッ プ 」 和 入力 を 介し て 、 誘 導 ダ イア ログ 、 キ ー ボ ー ド 、 コ ンピュータ マウ ス 、 人 触覚 
イン ター フェ ー ス 、 仮 想 現実 イン ター フェ ー ス 、 拡 張 現 実 和 インター フェ ー ス 、 音響 イン タ 
ー フ ェ ー ス 、 身体 追跡 イン ター フェ ー ス を 介し て 、 筋 電 デ ー タ に 基づい て 、 脳波 デー タ に 
基づい て 、 神 経 イ ンタ ー フ ェ ー ス を 介し て 、 ま た は それ ら の 組み 合わ せ を 介し て エン トリ 
が 可能 に な る よう に 設計 お よび 設定 され る 、 請 求 項 1 8 に 記載 の ロボ ッ ト (1 ) 。 

【 請求 項 2 0 】 

前 記 ヒ ュー マン マシ ン イ ンタ ー フ ェ ー ス HMI は 、 BRN, HSH, MSH, RBM, 
触 知 的 、 ま た は 電気 的 フィ ー ド バッ ク 、 ま た は それ ら の 組み 合わ せ を 提供 する よう に 設計 
お よび 設定 され る 、 請 求 項 1 8 また は 請求 項 1 9 に 記載 の ロボ ッ ト (1) 。 

【 発明 の 詳細 な 説明 】 
【 技術 分 野 】 
[0001] 

本 発明 は 、 ロ ボッ ト の 衝突 処理 方 法 、 お よび この 方 法 を 実行 する よう に 設計 お よび 構成 
され た ロボ ッ ト に 関す る 。 
[0002] 


通常 
いる 。 


で その 環境 に 接触 し て いる 。 膝 で の 衝突 物 と の 望ま し く な い 接 触 な どの 、 望 まし く な い 衝 


RIZE 
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、 操 作 タ スク を 実行 する ヒュ ー マ ノ イド ロボ ッ ト は 、 和 複数 の 接点 で 環境 と 接触 し て 


ロボ ッ ト は 、 接 地 接触 を 介 し て 足 で 、 お よび 有 所望 の 操作 タス ク を 実行 する た め に 手 


し く 反 応 す る た め に 、 ロ ボッ ト は 衝突 を 検出 し 、 接 触 状 況 を 分 析 し 、 そ れ に 応じ て 


反応 す 


る 能力 を 持た な けれ ば な ら な い 。 要約 する と 、 衝 突 を 検出 、 分 離 、 特 定 す る 必要 が 


ある 。 マ ニ ビ ピュ レー タ の 衝突 検出 の 問題 に 対す る アプ ロー チ は いく つか 存在 する 。 非 特許 
文献 [221、[19] で は 、 モ デル に 基づい た 基準 トル ク が 、 モ ー タ ー 電 流 を 介 し て 測定 され た 
アク チュ エー タ ト ル ク と 比較 され る 。 非 特許 文献 [12]1 は 、 適 店 イン ピー ダン スコ ント ロー 
ラ で 同様 の アプ ロー チ を 使用 する 。 非 特許 文献 [20] は 関節 間 の 連結 を 無視 し て 、 関 節 ご と 


に 外乱 


トル ク を 観 祭 する 。 上 記 の 方 法 は すべ て 、 衝 突 検出 に 時 不変 の 閥 値 を 使用 する 。 推 


定 モ デル 化 誤差 に 基づく 時 変 賠 値 を 使用 し た アプ ロー チ は 非 特許 文献 [171、[161 に あり 、 


一 般 化 


され た 運動 量 ベ ー ス の オブ ザー バ を 使用 し て 、 関 節 の 外乱 トル ク 、 ま た 、 モ デル 化 


誤差 の 境界 を 推定 する 。 前述 の すべ て の 方 法 の 欠点 は 、 一 般 に 高い ノイ ズ が 発生 する 、 つ 


£ U 
は 、 触 


加速 度 測定 が 必要 と な る 。 通常 、 接 触 位置 を 見 つけ る 為 の アプ ロー チ (衝突 分 離 ) 
覚 ス キン を 利用 する 非 特許 文献 [21、[11]、[10]、[18]。 適 切な 触覚 スキ ン に より 、 


接触 位置 を 正確 か つ 確 実に 見 つけ る こと が で きる 。 た だ し 、 追 加 の セン サー を 必要 と せ ず 
に 、 固 有 受 容 感 知 の み を 使用 し て 、 で きる こと が 望ま し い 。 衝突 の 特定 は 、 外 部 接触 レン 


チル 4 お よび 外部 の 一 般 化 関節 力 て 。, を 求め る こと を 目的 と し て いる 。 固定 ベー ス の シリ 


アル リ 
DLR 


され た 。 こ れ は 、 衝 突 を 検出 し 、 接 触 位置 を 見 つけ 、 外 部 トル ク を 推定 する 、 つ まり 、 衝 


突 処理 
特性 を 


ンク ロボ ッ ト の 外部 関節 トル ク 推 定 は 非 特許 文献 [6] で 提案 され 、 非 特許 文献 [31 の 
(ドイ ツ 航 空 宇宙 セン ター) 軽量 ロボ ッ ト に て 柔軟 関節 ロボ ッ ト に 拡張 お よび 検証 


問題 の 最初 の 3 つの フェ ー ズ を 同時 に 解決 する 最初 の 方 法 で あっ た 。 こ の アプ ロー 


加速 度 の 測定 に 依存 し な い 、 一 般 化 され た 運動 量 ベ ー ス の 外乱 オプ ザー バ の 減 結 合 


利用 する 非 特許 文献 [4]1、[9]1。 コ ンタ クト レン チ は し ば し ば 、 カ ント ルク セン サ の 


助け を 借り て 決定 され る 。 非 特許 文献 [141 は 、 測 定 さ れ た 足 の 力 を 直接 除外 し た 、 一 般 化 


され た 運動 莉 ベー ス の 外乱 オブ ザー バ を 使用 し て 、 ヒ ュー マ ノ イ ドロ ボッ ト ア の O〆 の の 操 
作 か ら 生 じ る 外部 関節 トル ク の み を 推定 する 。 接触 力 推定 の た め に 、 手 で の 接触 が 想定 さ 
れる 。 非 特許 文献 [1 で は 、 ヒ ュー マ ノ イ ドロ ボッ ト の 足 で の 接地 接触 力 は 、 所 望 の 総 加 
力 に 基づい て 最適 な 負荷 分 散 ア プロ ー チ で 推定 され る 。NASA ロ ボッ ト 「 ヴ ァ ル キリ ー」 
の 場合 、 こ れ ら は 足首 に ある カン トル クセ ン サ で 測定 され る 非 特許 文献 [15]。 

【 先行 技術 文献 】 

【 非 特許 文献 】 

[0003] 

上 記 の 先行 技術 の ソー ス お よび 追加 の ソー ス は 次 の と お り で ある 。 

【 非 特許 文献 1 】[1] K. Bouyarmane and A. Kheddar. On the dynamics modeling of f 


ree-floating-base articulated mechanisms and applications to humanoid whole-body 
dynamics and control. Humanoids, 2012. 


【 非特 


toward 
13. 
【 非特 


er. Col 


or arm. 


【 非特 
olation 


【 非特 


许 文 献 2 ) [2] R. S. Dahiya, P. Mittendorfer, M. Valle, et al. Directions 
effective utilization of tactile skin: A review. IEEE Sensors Journal, 20 
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许 文 献 5 】 [5] A. De Luca and R. Mattone. An adapt-and-detect actuator fdi 


scheme for robot manipulators. In ICRA, 2004. 


【 非特 


许 文 献 6 ) [6] A. De Luca and R. Mattone. Sensorless robot collision detec 


tion and hybrid force/motion control. In ICRA, 2005. 
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[ 非 特許 文献 7 [7] S. Haddadin. Towards Safe Robots. Springer Berlin Heidelber 
g, 2014. 
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【 発明 の 概要 】 
【 発明 が 解決 し よう と する 課題 】 
[0004] 

本 発明 の 課題 は 、 ロ ボッ ト 、 和 特に ヒュ ー マ ノ イド の 、 よ り 効 果 的 な 、 衝 突 の 検出 か ら 識 
別 ま で 、 お よび 分 離 を 提供 する こと で ある 。 
【 課題 を 解決 する た め の 手 段 】 
[0005] 
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る ue 


本 発明 の 第 1 の 態様 は 、 少 な く と も 1 つの 運動 連鎖 を 含む 運動 連鎖 構造 を 有 す 3 
ト の 衝突 処理 方 法 に 関し 、 運 動 連鎖 構造 は 、 ベー ス 、 リ ンク 、 リ ンク を 接続 する 関節 
クチ ュ エ ー タ お よび 少な く と も 1 つの エン ド エ フ ェ ク タ 、 カ ント ルク を 測定 ノ # s s. 
め 少 な く と も 1 つの 運動 連鎖 の 最 遠 位 リ ンク に ある セン サ Saar ム お よび 固有 受容 デー 
タ を 測定 グ 推 定 す る た め の セ ン サ ら S,、 で 構成 され 、 セ ン サ 9 は 、 運 動 連鎖 構造 に 沿っ て 
任意 に 配置 され 、 こ の 方 法 は 、 

- ロボ ッ ト の ダイ ナミ クス を 記述 する モデ ル を 提供 し 、 

- 少な く と も 1 つの 運動 連鎖 の 最も 遠 位 の リン ク で 、 セ ン サ Sasaki で カト ルク 
Fexesaistarg を 測定 お よび ググ また は 推定 し 、 

- セン サ S, に より 固有 受容 デー タ : ベー ス お よび ロボ ッ ト の 一 般 化 座標 q( 〇 ) お よび そ 
れ ら の 時 間 微 分 9()、 一 般 化 関節 モー ター カ r ィ 。』、 外 力 廊 、 ベ ー ス 方 位 es(D) お よび ベー ス 速 
HEx(t)g. ZM 定 お よび ノ ま た は 推定 し 、 

- 固有 受容 デ 一 夕 お よび モデ ル の 少な く と も 1 つ に 基づい て 、 運 動 量 オ プ ザ ー バ で 一 
般 化 外力 て 4 の 推定 値 を を 生成 し 、 

- そお よび て 。 に 基づい て 、 ベ ー ス お よび ロボ ッ ト の 一 般 化 座標 9( り の 2 次 導 関 数 の 推定 
up aha 

- GODCHOW C. GHB LOA DOF AW b REL EHE L. 

- HEE AGB Viv Poe gi BUB BILD . Epi d&O < Wl s 7] SORE L USE 72 2 E IC xF 
LC Fy REL. 

- 予期 し な い 衝 突 か ら 生 じ る 一 般 化 関節 力 の 推定 を 。。。。 を 取得 する た め 、 ヤ コ ビ ア ン 
Js aistat.i ZË WA され た Fext S distalt te 対し て を を 補正 し 、 お よび 、 

Toxt,col olives Qw/ E た tk Fexesi > Fs ihres O BE 与え D 7 E B] 8 Tinresn 3 LU 
Ficnresh に 基づい て 衝突 を 検出 する 、 

ス デ ッ プ を 含む 。 


【0006】 

いく つか の 場合 、 上 記 お よび 以下 で 実行 中 の イン デック ス が 使用 され る 。 当 業者 は 
有限 集合 の 要素 の 数 も 「1」 で あり 得る が 、 複 数 の 有限 集合 また は 場合 に よっ て は 無限 集 
合 の それ ぞ れ の 要素 を 示す た め の 記 述 と し て これ を 理解 する 。 特に 、: が ロボ ッ ト と 外部 
オブ ジェ クト と の 衝突 の それ ぞ れ の 番号 付け を 参照 し 、-1 が 成り 立つ 場合 に の み 常 に 、 
それ は 1 つの 衝突 し か な いこ と を 意味 する 。! が isl また は と 2 の 場合 、2 つの 衝突 が 参 
PANS, 同じ こと は 、 衝 突 の 番号 付け を 超え て 、 セ ン サ な どの 番号 付け に も 適用 され る 。 


[0007] 

ロボ ッ ト の ダイ ナミ クス を 記述 する モデ ル に は 、 特 に 質量 に 関す る 情報 、 特 に 運動 連鎖 
構造 に 沿っ た 質量 分 布 が 含ま れる 。 後者 か ら 、 運 動 連 鎖 構造 の 慣性 モー メン ト も 知ら れ て 
WS, 

[0008] 
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ロボ ッ ト は 、 好 まし く は ヒュ ー マ ノ イド ロボ ッ ト で あり 、 好 まし く は 次 の よう に モデ ル 
化 さ れる : 


Mgs Maj, dp Cs (Q). dg gp、 ,0、 ,0 TBext 
(Mjs uy GG 3 Cc (q)) a)? d (g) ー Gm? Ç + (ra 


) 式 (1) 

IIT, ap — (nQog) dk UO q— (qua! is, FHV b O0 — A ftii rg ER? オ イラ ー 角 の 
ベー ス 方 位 o』 eE RR お よび 関節 角 gq, e RW り か ら な る ベー ス お よび ロボ ッ ト 一 般 化 座標 を ボ す 
o ペー ス お よび 関節 エン トリ は 、 印 「B」 と 「」」 で 示さ れ て いる 。 き ら に 、 式 (1) は 
より コン パク ト な 形式 で 記述 され うる : 


M(q)G + C(q,q)q + 9(9) = tm — Ty + Text X (2) 

ここ で 、MWM(9) は 質量 行列 、C(④⑰9) は 遠心 お よび コリ オリ 項 の 行列 、g(9) は 重力 ベク トル 
で あり 、g へ の 依存 性 は 式 (1) の 簡潔 さ の た め に 省略 され て お り 、 簡 潔 に する た め に 、 
9( り と その 時 間 導 関数 は 、g7 お よび 9 な ど と し て 短く 記述 され る 。 ベク トル て て と と Text lt. 
一 般 化 さき れ た モー ター 関節 カ 、 摩 擦 関 節 カ 、 お よび 外部 関節 カカ を 示す 。 デ カル ト 力 記 お よ 
び モ ー メ ント mg は 、o』 = ニ 太 (pg) の 角速度 ヤ コ ビ アン / 選 で 、 ベ ー ス 一 般 化 回 転 座標 に 投 
影 さ れる 。 一 般 化 外 力 ル ん は 、 接 触 点 友 , の 対応 する 幾何 学 的 浮動 ベー スヤ コ ビ ア ン ル , を 
St し て 一 般 化 関節 フ 


Tpext,i 


_ —S(rscide Rinc. olerki 
Text, = (て , exti 


)2J Forti = (3 
QI M 0 Jo R]ici "exti 


) A (3) 


行列 で あり 、A は ロボ ッ ト ベ ー ス か ら ワ ー ル ド フ レー ム へ の 回 転 行列 で ある 。 非 特許 文献 
[141 お よび [1] を 参照 。 


[0009] 

運動 連鎖 構造 は 、 好 まし く は 、 関 節 ト ルク 感知 と 、 運 動 連鎖 構造 に 沿っ て 任意 に 配置 き 
れ た カト ルク を 渦 定 する た め の 任意 の 数 の セン サ S を 含む 。 さ ら に 、 ベ ベース 方 位 ゅ 』 お 
よび 一 般 化 ベー ス 速 度 怒 を 測定 で きる 。 一 般 的 な 目的 は 、 外 部 オプ ジェ クト と 運動 連鎖 構 
造 の 衝突 を 検出 、 分 離 、 識 別 す る こと で ある 。 これ に 関連 し て 、 衝 突 検出 と は 、 特 に 、 ロ 
ボッ ト の 特定 の トポロジ ー 部 分 で 衝突 が 発生 し て いる か どう か を 示す 多数 の 二 値 信号 を 生 
成す る こと を 意味 する 。 分離 は 、 衝 突 i の 接触 位置 , を 見 つけ る こと を 意味 する 。 識別 は 、 
一 般 化 外部 関節 カ て 。。。 お よび 外部 接触 レン チル 4 の 推定 を 目的 と し て いる 。 要約 する と 、 
的 は 、 す べ て の 接触 位置 、 対 応 す る 接触 レン チ を 見 つけ 、 運 動 連 鎖 構造 の どの 部 分 が 特 
定 の 時 間 に 衝 突 し て いる か を 知る こと で ある 。 


[0010] 

特に 、 以 下 の 測 定量 に つい て 、 測 定 お よび また は 推定 値 は 次 の よう に 提供 され る : 
- ベ ペース 方 位 pp( 〇 ) お よび ベ ペース 速度 (Og : 好ま し く は 、 ジ ャ イロ スコ ー プ お よび ププ ま た は 
カル マン 推定 問 で 取得 する : 

- リ ンク の 場合 : て 。: カノ グ ト ルク セン サ お よび カノ グ ト ルク セン ササ 付き の Fe で; 

- エ ンド エフ ェ ク タ の 場合 : Fei 力 / ト ルク タク セン サ で ; 


[0011] 
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すべ て の 接触 に よっ て 生成 され る 一 般 化 外力 て の 推定 値 を は 、 運 動 量 オブ ザー バ の 助 
け を 借り 、 固 有 受 容 デ ー タ と モデ ル の 少な く と も 1 つ に 基づい て 取得 され る 。 非 特許 文献 
[41、[5]、[7] か ら の 一 般 化 され た 運動 量 オ ブザー バ が 適用 され る こと が 望ま し く 、 こ れ は 


t, = Ko = (M(a)à — fo [ts ーY( の の 1 の x (4) 


と 定義 され る 。 


[0012] 
これ は 、 運 動 連鎖 構造 に 作用 する 一 般 化 外力 の 推定 値 そ を 生成 し < Z G. Ko= 
diag kon > 0 は オブ ザー バ ゲ イ ン 行 列 で あり 、M(q) — 2C(9④. の の 歪 対称 性 の た め 、 


Y(q, d): = n(q,q) — M(q)q = g(q) + C(q,q)q — M(q)à = 9(9) — C' (q, の 9 式 (5) 


で ある 、 非 特許 文献 [3] 参 照 。 理想 的 な 条件 下 で の 9 MULCA 9), 9(9) は 正確 に 知ら れ て お 
ua ee ee クス は 分 離さ れ 、 す べ て の 成分 で は 一 次 の ダイ ナミ クス : 


Ke Sh 式 (6) 


に 従う 。 BIC, PII, eaP RTIA 2 U a Y Gb. 


[0013] 

接触 レヒ ンチ と 位置 の 最大 数 を 決定 で きる よう に する た め 、 非 特許 文献 [21]1 に ぶす よう に 
観測 され た 一 般 化 外部 関節 力 を か ら の カン トル クセ ン サ の 情報 は 除外 され る こと が 好ま し 
い 。 し た が っ て 、 v 取り 付け られ た 慣性 に よっ て 生成 され る 動 的 お よび 静 的 な カ 
が 補正 され る 。 この 補正 に は 、 重 心 の の デカ ルト 空間 和 の 加速 度 が 必要 で ある 。 好ま し 
く は 、 


žo = GP) = Jodi + Jod A (7) 


で 計算 きれ 、 こ こ で 、 記 は 点 の の ヤ コ ビ アン で ある 。 こ の た め 、 デ カル ト 加 速度 を 計算 す 

る に は 一 般 化 加速 度 9 が 必要 で ある 。94 の 推定 値 9 は 、 式 (4) に 示す よう に 外乱 オブ ザー 

Pa db こと で 取得 で きる 。 その 内 部 状態 、 つ まり 一 般 化 運動 量 p = M(g)g を 使用 し 
、 時 間 微分 の 推定 値 : 


b = M(q)Q + M(q)q = Tm = Y(q, q) + t, 式 (8) 


に 従う 。 こ れ か ら 、 推 定 加 速度 は : 


q = M(q) (b — M(q)d) = M(q) Co —n(q,d) + tO) X (9) 


[0014] 
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加速 誤差 *= ガ ヨー9 の ダイ ナミ クス は 、 式 (8) を 使用 し て 導出 され る : 


e = M(q) (p — M(q)d) - M(q) È — M(q)d) f 
一 M(q)* Gin i n(q, q) T Text 一 (îm = n(q, 9) て 。)) 式 ( 1 0 ) 
= M(q) (text T îe) 
[0015] 
X (6) BLUR (10) の ラブ ラス 変換 を 使用 し 、 次 の ダイ ナミ クス が 取得 され る : 


- ska A text Sko A Textn ` 
e=M(g) 人 PV onl peto prece d X (11) 
[0016] 

エダ ター グイ サミ クス は 、 て 4 に よっ て トリ ガー きれ る 線形 ゲイ ナミ decre トル 
で 構成 され 、 て 。。。 は 、 逆 質量 行列 に よっ て エラ ーe に 非線形 的 に 結合 され る 。 以下 に 示す 


E54 coU. muU CM 
を 取得 する こと が で きる 


[0017] 
HEEB YF Poy s RET SI b Oo p C E < MAPS IFS 2 Z22336 k CUE 12) 
果 に 対す る 測定 され た 一 般 化 外力 岳 の 補正 は 、 次 の よう に 行う こと が 好ま し い : 


エン ド エ フ ェ ク タ に 隣接 する ボディ か ら の フリ ー ボ ディ 坊 粋 を 考慮 し て 、 ニ ュー トン の 第 
二 法 則 は 、 こ の ボディ に 取り 付け られ た セン サ を 生成 する : 


mptp = mag + fext — fs 式 (1 2) 


ここ で 、mp は 体質 量 で あり 、 そ の 慣性 テン ソル は な で ある 。 一 般 に 、 セ ン サ で 測定 され 
る 重力 お よび 動 的 な 力 が ある が 、 動 的 な 力 は 式 (12) の 左側 に 表示 され る 。 感知 され た 
外力 に つい て は 次 の と お り で ある 


fexts = fs + mpfp — mag = (1 3) 


[0018] 


X (13) は 、 セ ン サ が 純粋 な 外力 の み を 測定 する の で は な く 、 一 般 に 重力 と 慣性 に よ 
る 力も 測定 する こと を 示し て いる 。 し た が っ て 、 岳 は 、 真 の 外部 レン チ を 取得 する た め 
これ ら の ダイ ナミ クス に よっ て 修正 され る 。 外 部 モー メン ト を 取得 する た め に 、 剛 体 運 8 


の オイ ラー の 法則 が 体 の 重心 の に 適用 され る : 


lpop + Wp X [gp = Mext e — ms — rps X fs + Tpg X fext X (1 4) 


これ は 、 感 知 さ れ た 外部 モー メン ト 


Mext,s: = Mext,e + Tsg X fext = mç + IpGyp + Wp X Ipwp + Tps X (fs — fext) 式 (1 5) 
に つなが る 。 


[0019] 


(11) JP 2020-521645 A 2020.7.27 


zx (13) お よび 式 (14) は 、 外 部 レン チ 


TANE fs ) = Fs + mpls X (16) 


Me MpS (Tsp) Ge. E Qt G. nom 


に な る 。 式 (16) CH. RUE 3 D 50412]. gF PEJS FV. roii vd 
に 取り 付け られ た 慣性 の 重心 か らち セン サ へ の クト ル 、 お よび 0 は 対応 サイ ズ の ゼロ 行列 
で ある 。$ 演 算 子 は 、 引 数 を 持つ 外 積 を 表す 歪 対 称 性 行列 を 示す 。 す べ て の エン ティ ティ 
は ワー ルド フレ ー ム で 表わさ れる 。@ の 代わ り に 8 す を 使用 し て 旨 を 計算 する と 、5$ 点 の 推定 
外部 レン チ は 次 の よう に 取得 で きる : 


I < 
OCG 式 (は 7) 


[0020] 
セン サ が 運動 連鎖 の 遠 位 端 に な い リ ンク に ある 場合 、 運 』 
5 の 補正 レン チ は 


鎖 の セン サ に 従う 各 ボ ディ 


mi 
ey 
> 


0 
COp ぁ Xp の pp 


mp.ls 
mp.pS(rspp) Id.» 


) 式 (18) 


Feb = X5 - By) + ( 


A, TATO Ee ORI Hh Sates DORTE, Vee ae Par 


ミク ス を 計算 する た め の ニ ュー トン オイ ラー 法 に 対応 し て いる 。 故に 、 こ の 場合 、 外 部 レ 
ンチ は 特に 
Foxes = Fs + Fep =: Fs + Fomp,s 
bEN(bs) 
=x (1 9) 


に より 得 ら れる 。 


[0021] 


X (19) で は 、W(p。) は 
ボディ の セッ v を 示す 。 


運動 連鎖 に お いて セン サ を 保持 する 遠 位 方 向 の 肢 p に 従う 


" 


[0022] 


以下 で は 、 Yu € Y Jidistai SHR SAUTE, Fext, S.distali lZ こ 対 し て ?。 を 柄 正 し て 、 予期 しない 
衝 笑 か ら 発生 する 一 般 化 関節 力 の 推定 そ 。。。。。 を 得る た め の 好 まし い 方 法 が 表示 され る 


[0023] 
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特に 、 一 般 化 接触 力 の 推定 お よび 衝突 検出 の た め に 、 オ ブザー バ が すべ て の 外部 接触 か 
ら 生 じ る 一 般 化 外部 関節 力 を 検出 する こと が 考慮 され る 。 ヒ ュー マ ノ イ ド の 場合 と 同様 に 、 
一 艇 的 に 常に 望ま し い 接 触 が ある (操作 中 の 足 や 手 な ど )。 これら の 接触 力 は 、 観 測 さ れ 
< 一 般 化 関節 力 か ら の 除外 を 可能 に し 、 望 まし く な い 衝 突 検 出 (「 誤 報 」) を 回 避 す る た め 
に 、 対 応 す る エン ド エ フ ェ ク タ (手首 や 足首 な ど ) に 近い カト ルク セン サ で 測定 する 必 
要 が ある 。 好 まし く は 、 カ トル クセ ン サ Sizux は 、 ヒ ュー マ ノ イ ドロ ボッ ト の 腕 と 脚 の 
遠 位 リ ンク の 運動 連鎖 構造 に 取り 付け られ て いる 。 予 期し な い 衝 突 て 。z.。。, に 起因 する 一 般 
化 関節 力 の 推定 値 を 取得 する た め に 、 遠 位 リ ンク の 外部 レン チ に よっ て 生成 され る 一 般 化 
外部 関節 カカ を 、 観 測 さ れ た 一 般 化 関節 力 か ら 差 し 引く こと が 好ま し い : 


A iR T 
Text,col = TE = Is.aistat,iMext.s.distal,i 
S.distal 


A (20) 


[0024] 

カノ トル クセ ン サ が 補正 され 、 所 望 の 一 般 化 外力 が 観察 され た 一 般 化 外力 か ら 除 外さ れ 
た の で 、 和 衝突 検出 は 以下 の よう に 行わ れる こと が 好ま し い 。 

[0025] 
衝突 検出 は 、 一 般 化 関節 力 と 推定 外部 レン チ を 使用 し た 関 値 処理 に よっ て 行わ れる こと 
が 好ま し く 、 す な わ ち 好ま し く は 、 次 の 条件 (要素 ご と に チェ ッ ク さ れ て いる ) の 少な く 
と も 1 つが 満た され て いる 場合 で ある : 


F 


t >T 
A ext,col thresh a ( 2 1 ) 


Fext si > FSi thresh 


[0026] 

本 発明 の 利点 は 、 ヒ ュー マ ノ イ ドロ ボッ ト の 加速 度 推定 お よび 負荷 補正 の た め の 新 し い 
実 時 間 法 が 、 ロ ボッ ト の 運動 連鎖 構造 上 に 任意 に 配置 され た カン トル クセ ン サ に 提供 され 
る こと で ある 。 

[0027] 

本 発明 の 利点 は 、 ヒ ュー マ ノ イ ドロ ボッ ト の 加速 度 推定 お よび 負荷 補正 の た め の 新 し い 
実 時 間 法 が 、 ロ ボッ ト の 運動 連鎖 構造 上 に 任意 に 配置 され た カノ トル クセ ン サ に 提供 され 
る こと で ある 。 


[0028] 
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好ま し く は 、 式 (1 9) に 基づい て 、 運 動 連 鎖 (例え ば 、 各 関節 ) 内 の 複数 の セン サ に 
つい て 、 こ の 実施 形態 に よれ ば 、 Mp a i 複数 の 計算 を 回 避 す る た め に 再帰 的 に 計 
算 さ れる 。 好 まし く は 、 こ れ は 、 こ こ に 擬似 ヌー ド で 書か れ た 以下 の アル ゴリ ズム に 従っ 


function Fonps= calculate F cmDp(S) 


begin 


Fomp,s: = 0 
for all bodies b directly following S do 


pp =Jppä + Jpsd 


Mp pls 0 


Fonps + Cy RAS) qno - 


end 
for all TEN(S) do 
Fonpr-calculate F cmp(T) 


VM 
Tsr X fext T 


Wpp X Ip gOpp 


Femp,s + =Fomp,T F ( 


end 
end 
[0029] 
LOT uy XA. NOE v EAL, Snid, BREA csuciEBQEO-d eco 
セン サ を 示す 。 直接 と は 、 ゞ と AM⑮) の 要素 の 2 つ を 接続 する 運動 連鎖 の 間 に 他 の セン サ が 
な いこ と を 意味 する 


[0030] 

c の 実施 形態 の 利点 は 、 複数 の 計算 を 回 避 す る こと で ある 。 

[0031] 

本 発明 の 別 の 実施 形態 に よれ ば 、 こ の 方 法 は さら に 以下 の ステ ッ プ を 含む : 

- 衝突 の = (ST(fi) mi G. AOE II お よび 、 力 の 作用 線 


と 運動 連鎖 構造 の ツジ ゲオ メト リ を 交差 させ る こと で 、 運 動 連 鎖 構造 と の 衝突 の 接触 位置 た を 
決定 する 


[0032] 
£ (2 1) の 情 
BCH A SRRORM ERIE LDL, C 2 RB Z ZË VAI OE 1 t k O |ñ] GP h rt Hic 
位置 決め 可能 で ある 。 接触 し て いる リン ク に 関す る 詳細 情報 を 取得 する に は 、 外 部 レン チ 
Fo iD EE CÓ 5. 以下 に 、 玉 4 を 取得 する 好ま し い 方 法 と 、 そ れ を 衝突 分 離 に 使用 する 
方 法 を 示す : 


mË 
fe 


[0033] 


報 は 、 接 触 位置 を 大 ま か に 推定 する た め に も 使用 され る こと が 好ま し い 。 
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一 般 に 、 外 部 モー メン ト が ロボ ッ ト に 沿っ て 作用 する 場合 、 衝 突 分 離 は 処理 で き な い 。 
この 場合 、 追 加 的 に 作用 する 接触 力 の 接触 位置 を 正確 に 特定 する こと は で き な い 。 RIC, 
分 離 の 場合 、 こ こ で は ロボ ッ ト に 外部 モー メン ト は 作用 し て いな いと 想定 され (7。。。』 = 0) 
、 こ れ は 、 ほ と ん どの 望ま し く な い 衝 突 状 況 の 現実 的 な 仮定 で ある 。 DHE. KO 4 段階 
の アプ ロー チ を 介し て 行わ れる : 

a) 接触 リン ク を 分 離し 、 

b) それ ぞ れ の 接触 リン ク に 作用 する 外部 レン チ を 推定 し 、 

c) 推定 され る 力 の 作用 線 を 計算 し 、 お よび 
d) 作用 線 を 既知 の 運動 連鎖 構造 ジオ メト リ と 交差 させ て 、 正 確 な 接触 点 を 決定 する 。 


突 
V^ 


[0034] 

ステ ッ プ b ) と c ) の 場合 、2 つの 主要 な シナ リオ を 区 別 す る 必要 が ある : 単 一 接触 と 
多 接触 の シナ リオ で ある 。 単 一 接触 シナ リオ は 、 関 節 ト ルク 感知 で の み 処 理 で きる が 、 多 
接触 シナ リオ で は 、 異 な る 接触 を 区 別 す る た め に 追加 の カプ トル クセ ン サ が 必要 に な る 場 
合 が ある 。 

[0035] 

ステ ッ プ a) に 関し て : 接触 リン ク は 、 例 えば 、 上 腕 で の 接触 は 手首 に トル ク を 生成 で 
き な い と いう 、 運 動 連 鎖 に 沿っ た 接触 位置 の 後ろ に 現れ る 関節 で 接触 が トル ク を 生成 で き 
な いと いう 事実 に 基づい て 見 つけ る こと が で きる 。 Mil, BD / が リン ク を ロ ボット 
の 先行 リン ク に 接続 する と いう 規則 が 与え られ て いる 場合 、 接 触 リ ンク イン デック ス i 
は 


i = max {j | Text,conj # 0} Be) 


で 分 離す る 事 が で きる 。 ヒ ュー マ ノ イ ド の ツリ ー 構 造 に より 、 こ の 手順 は 複数 の 潜在 的 な 
接触 リン ク に つなが る 可能 性 が ある 。 ま た 、 モ デリ ング と 渦 定 の 誤差 に より 、 式 (2 2) 
は 賠 値 処理 の 対象 と な る こと に 注意 する 必要 が ある 。 ま た 、 い くつ か の カカ 、 例 えば 作用 す 
る リン ク に 接続 され た 関節 の 軸 に 平行 な 力 は 、 こ の 関節 で トル ク を 生成 し な い 。 こ れ は 、 
接触 リン ク の 誤っ た 推定 に つなが る 可能 性 が ある 。 た だ し 、 こ の 問題 は 、 後 で 導入 する 修 
正 手 順 で 対処 で きる 。 


【0036】 
ステ ッ プ b) に関して: 接触 リン ク が 見 つか っ た 場合 、 そ れ ぞ れ の リン ク に 作用 する レ 
ンチ 瓦 は 、 だ の ムー ア ・ ペ ン ロ ー ズ の 疑似 逆行 列 07) を 使用 し 、 


F, = の) 式 ( 2 3 ) 


と し て 好ま し く は 推定 され る 。 


[0037] 
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ステ ッ プ c) に 関し て : 接触 位置 な で 作用 する 単 一 の 外部 レン チ 玉 。 ORB. bY FF, 
は 次 の よう に 表 さ れる : 


I 0 s 
F, = Je iF ext = (srr) pFext X (24) 


外部 モー メン ト が 存在 し な いと いう 仮定 を 想起 する と 、 


fi fext fi 


Fi = (y) = Cane = Greg) X ( 25 ) 


と い う 結 果 に な る 。 
X (25) か ら 、 カ の 作用 線 が 導き 出さ れる 。Ae R'Crg - ARIA Ko TEREN., 


ra = (ST (fmi 式 (2 6) 
で ある 。 


[0038] 


ステ ッ プ d) に 関し て : 疑似 逆行 列 の 特性 と 歪 対称 行列 の ラン ク 不 足 の た め 、 る は 力 の 
作用 線 に 沿っ た 点 で あり 、 原 点 に 最も 近く 、 し た が っ て を と は 一 般 的 に 同一 で は な い 。 カ 

線 を 接触 リン ク の リン クジ オメ トリ と 交差 させ る こと に より 、 な を 計算 する こと が 
る 。 この 交点 問題 に 複数 の 解 が ある 場合 、 最 小 の パラ メー タ 和 を も つ 解 が 選択 され る 
。 こ れ は 、 予 期し な い 衝 突 の 場合 に は 最も 一 般 的 な 押圧 力 が 予想 され る た めで ある 。 た だ 
し 、 よ り 高 度 な 抽象 度 で より 高度 な 処理 が 行わ れる 場合 、 す べ て の 候補 を 生成 し て 利用 で 
& 5, 接触 リン ク が 正しく 推定 され な い 場 合 で も 、 ベ ー ス ムー ブ メ ント は それ を 決定 する 
の に 十分 な 情報 を 提供 する た め 、 単 一 接触 ケー ス の 接触 点々 を 計算 で きる 。 この 場合 、 作 
H 線 は 、 推 定 さ れる 接触 リン ク と 交差 し な いこ と が ある 。 政 に 、 接 触 点 を 々 は 、 好 まし く は 
、 作 用 線 を 後続 の リン ク と も 交差 させ る こと に より 正しく 決定 され る 。 複数 接触 の 場合 、 
上 記 の 方 法 は 、 カ ント ルク 感知 と 組み 合わ せ て 使用 する こと が 好ま し い 。 次 に 、 各 セン サ 
に 対し て 、 セ ン サ の 補正 され た ( 式 (1 9) の よう に ) レン チル 4 に ステ ッ プ 3 お よび 4 
を 適用 する こと に より 、 セ ン サ に 従う 運動 連鎖 の 接触 が 好ま し く は 検出 され る 。 運動 連鎖 
に 複数 の セン サ と 和 複数 の 接触 が ある 場合 、 運 動 連 鎖 の 遠 位 端 に 近い セン サ に よっ て 既に 渦 
定 き され た 接触 か ら 生 じ る レン チ は 、 連 鎖 の 早い 段階 で 接触 を 正しく 推定 する た め 、 測 定 さ 
れ た レン チ か ら 差 し 引か れる 必要 が ある 。 


š " 0 "n 
Foxti = Fextsi — Lren(sy)Pext,r + Gor x Pout my 式 (2 7) 


[0039] 

カノ トル クセ ン サ が な い 場 合 、 複 数 接触 の 正しい 分 離 は 、 接 触 リ ンク が 正しく 推定 され 
、 ベ ベース か ら 十 分 離れ て いる 場合 に の み 可 能 で あり 、 つ まり 、 接 触 リ ンク の ヤ コ ビ アン に 
は 、 推 定 す る レン チ ご ど ご と に 少な く と も 6 つの 自由 度 が 含ま れ て いる 。 こ の た め に 、 好 まし 
く は 、 接 触 レ ヒレ ンチ は 、 ヤ コ ビ ア ン を スタ ッ ク し 、 疑 似 逆 行列 


(F... Fia) et Jir- Jin Text,cot 式 (28) 


を 計算 する こと で 計算 され る 。 


[0040] 
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ヤ コ ビ アン の 特異 点 の 場合 、 レ ンチ を 正しく 推定 する た め に 追加 の 自由 度 が 必要 に な る 
c ç uiu uM. で きる 。 の ス 
テッ プ は 、 非 特許 文献 [141 の 式 (6) の 一 般 化 と 見 な すこ と が で きる 。 


[0041] 
B= ic 105. RAE BRE SNS. 
[0042] 


c の 実施 形態 の 利点 は 、 特 に ヒュ ー マ ノ イド ロボ ッ ト の 単 一 接触 シナ リオ に お ける 接触 
位置 お よび 接触 力 を 推定 する た め の 新 規 な 方 法 が 提供 され る こと で ある 。 
[0043] 
本 発明 の 別 の 実施 形態 に よれ ば 、 こ の 方 法 は さら に 以下 の ステ ッ プ を 含む : 
ES D A ESOT, ZEMEMY CT Joy = た 所 を 決定 し 、 
z 外部 レンチ : oum Flan) = (Jla. JE Terc E RET Dy 


[0044] 
上 記 に 、 接 触 位置 が 決定 され る た め 、 完 全 な 接触 ヤ コ ビ アン 


Jei = Jedi 式 (2 9) 
が 好ま し く は 計算 され る 。 式 (28) と 同様 に 、 外 部 レン チ 
(Fiar Fs, a) = Gl. JEn Text,cot 式 (3 0) 


を 識別 する た め に 使用 され る こと が 好ま し い 。 


[0045] 

カノ トル クセ ン サ で 特定 され た レン チ の 場合 、 修 正 さ れ た レン チ は 既に 最良 の 推定 値 で 
ある た め 、 こ の ステ ッ プ で アク ショ ン を 実行 する 必要 は な い 。 
[0046] 

c の 実施 形態 の 利点 は 、 上 記 の 発明 お よび その 実施 形態 の 拡張 が 、 運 動 連鎖 に お ける 追 
加 の カント ルク セン サ の 助け を 借り て 、 お よび 助け な し で 、 多 接触 状況 に 提供 され る こと 
CHS. 

[0047] 

本 発明 の 別 の 実施 形態 に よれ ば 、 こ の 方 法 は さら に 以下 の ステ ッ プ を 含む : 

- な お よび (所 し Eg) に 依存 する ロボ ッ ト の 制御 。 


[0048] 

本 発明 の 別 の 実施 形態 に よれ ば 、 ロ ボッ ト は ヒュ ー マ ノ イド ロボ ッ ト CHS. 
[0049] 

本 発明 の 別 の 熊 様 は 、 デ ー タ 処理 ユニ ッ ト を 有する コン ピュ ー タ シス テム に 関し 、 デ ー 
タタ 処理 ユニ ッ ト £. 先行 する 請求 項 の うち 1 つ に 記載 の 方 法 を 実行 する よう に 設計 お よび 
設定 され る 。 

[0050] 

本 発明 の 別 の 態様 は 、 電 子 的 に 読み 取り 可能 な 制御 信号 を 備え た デジ タル デー タス トレ 
ー ジ に 関し 、 制 御 信号 は 、 プ ログ ラム 可能 な コン ピュ ー タ シス テム と 共 働 す も る こと が で き 
、 そ れ に より 、 先 行 す る 請求 項 の うち 1 つ に 記載 の 方 法 が 実行 され る 。 

[0051] 

本 発明 の 別 の 態様 は 、 プ ログ ラム コー ド が コン ピュ ー タ シス テム 上 で 実行 され る 場合 

先行 する 請求 項 の うち 1 つ に 記載 の 方 法 を 実行 する た め の 機 械 可 読 媒体 に 格納 され た プロ 
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グラ ムコ ー ド を 含む コン ピピ ュー タプ ログ ラム プロ ダク ト に 関す る 。 
[0052] 

本 発明 の 別 の 態様 は 、 コ ンピュータ プロ グラ ム が コン ピュ ー タ シス テム 上 で 実行 され る 
場合 、 先 行 す る 請求 項 の うち 1 つ に 記載 の 方 法 を 実行 する た め の プ ログ ラム コー ド を 有 す 
る コン ピュ ー タ プロ グラ ム に 関す る 。 

[0053] 


本 発明 の 別 の 態様 は 、 少 な く と も 1 つの 運動 連鎖 を 含む 運動 連鎖 構造 を 有する ロボ ッ ト 
に 関し 、 運 動 連鎖 構造 は 、 ベー ス 、 リ ンク 、 リ ンク を 接続 する 関 館 、 ア クチ ュ エ ー タ 、 お 
よび 少な く と も 1 Pp ドド エフェクタ 、 カ トル ク を 測定 推定 する た め 少 な く と も 1 
つの 運動 連鎖 の 最速 位 リ ンク に ある セン サ %。。 i. お よび 固有 受容 デー タ を 測定 推定 
する た め の セ ン サ で 構成 され 、 セ ン サ ?, は 運動 連鎖 構造 に 沿っ て 任意 ( S e ` ロボ 
ッ ト は 先行 する 請求 項 に 記載 の 方 法 を 実行 する よう に 設計 お よび 設定 され て 


[0054] 

本 発明 の 別 の 実施 形態 に に よれ ば 、 ロ ボッ ト は 、 デ ー タ ネッ トワ ー ク と の デー タイ ンタ ー 
フェ ー ス を 備え 、 ロ ボッ ト は 、 デ ー タ ネッ トワ ー ク か ら ロ ボッ ト を 設定 お よび 制御 する た 
め の シ ステ ム プ ログ ラム を ダウ ン ロ ー ド する よう に 設計 お よび 設定 され る 。 

[0055] 

本 発明 の 別 の 実施 形態 に に よれ ば 、 ロ ボッ ト は 、 デ ー タ ネッ トワ ー ク か ら シ ステ ム プ ログ 
ラム の パラ メー タ を ダウ ン ロ ー ド する よう に 設計 お よび 設定 され る 。 
[0056] 

本 発明 の 別 の 実施 形態 に に よれ ば 、 ロ ボッ ト は 、 ロ ー カ ル 入 力 イ ンタ ー フ ェ ー ス お よび ン / 
また は ティ ー チ イン プロ セス を 介し て シス テム プロ グラ ム の パラ メー タ を 入力 する よう に 
設計 お よび 設定 され 、 ロ ボッ ト は 手動 で 誘導 され る 。 

[0057] 

本 発明 の 別 の 実施 形態 に よ に よれ ば 、 ロ ボッ ト は 、 デ ー タ ネッ トワ ー ク か ら の シス テム プロ 
グラ ム お よび ププ また は それ ぞ で れ の パラ メー タ の ダウ ン ロ ー ド が 遠隔 基地 に よっ て 制御 され 
る よう に 設計 お よび 設定 され 、 遠隔 基地 は デー タネ ットワーク の 一 部 で ある 。 
[0058] 

本 発明 の 別 の 実施 形態 に に よれ ば 、 ロ ボッ ト は 、 ロ ボッ ト で ロー カル に 利用 可能 な シス テ 
ム プ ログ ラム お よび プ ま た は それ ぞ れ の パラ メー タ が 、 デ ー タ ネッ トワ ー ク か ら 受 信 し た 
それ ぞ れ の 要求 に 基づい て デー タネ ットワーク の 1 人 以上 の 参加 者 に 送信 され る よう に 設 
計 お よび 設定 され る 。 

[0059] 

本 発明 の 別 の 実施 形態 に に れ ば 、 ロ ボッ ト は 、 ロ ボッ ト で ロー カル に 利用 可能 な それ ぞ 
れ の パラ メー タ を 有する シス テム プロ グラ ム が 遠隔 基地 か ら 開 始 で きる よう に 設計 お よび 
設定 され 、 遠隔 基地 は デー タネ ットワーク の 一 部 で ある 。 

[0060] 

本 発明 の 別 の 実施 形態 に よれ ば 、 ロ ボッ ト は 、 遠隔 基地 お よび ププ また は ロー カル 入力 イ 
ンタ ー フ ェ ー ス が 、 シ ステ ム プ ログ ラム お よび それ ぞ れ の パラ メー タ の 入力 の た め お よ び 
SEEMS PORE Hd c the ON eM ru Hu 


れ ぞ れ の パラ メー タ を 選択 する た め に 設計 お よび 設定 され た ヒュ ー マ ン マシ ン イ ンタ ー フ 
ェ ー ス HMI を 含む よう に 設計 お よび 設定 され る 。 
[0061] 


c HM n ヒュ ー マ ン マシ ン イ ンタ ター フェー ス HMI は 、 タ ッ チ 
スク リー ン で の 「 ド ラッ グ ア ン ド ドロ ッ プ 」 入力 を 介し て 、 誘 導 ダ イア ログ 、 キ ー ボ ー ド 
、 コ ンピュータ マウ ス 、 触覚 イ ン シ ンター フェー ス 、 仮 想 現実 イン ター フェ ー ス 、 拡 張 現 実 イ 
ンタ ー フ ェ ー ス 、 音響 イン ター フェ ー ス 、 身体 追跡 イン ター フェ ー ス を 介し て 、 筋 電 デ ー 
タ に 基づい て 、 脳波 デー タ に 基づい て 、 神 経 イ ンタ ー フ ェ ー ス を 介し て 、 ま た は それ ら の 
組み 合わ せ を 介し て エン トリ が 可能 に な る よう に 設計 お よび 設定 され る 。 
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[0062] 

本 発明 の 別 の 実施 形態 に に よれ ば 、 ヒ ュー マン マシ ン イ ンタ ー フ ェ ー ス HMI は 、 聴覚 的 
、 視 覚 的 、 触 覚 的 、 嘆 覚 的 、 触 知 的 、 ま た は 電気 的 フィ ー ド バッ ク 、 ま た は それ ら の 組み 
合わ せ を 提供 する よう に 設計 お よび 設定 され る 。 

[0063] 

本 発明 は 、 上 記 の 実施 形態 を 参照 し て 上 記 で 説明 され て いる 。 し か し 、 本 発明 が これ ら 
の 実施 形態 に 限定 され る だ け で な く 、 発 明 思 想 お よび 特許 請求 の 範囲 の 精神 お よび 範囲 内 
の すべ て の 可能 な 実施 形態 を 含む こと は 明らか で ある 。 

【 図面 の 簡単 な 説明 】 

0064】 

図 1 】 図 1 は 、 本 発明 の 一 実施 形態 に よる ロボ ッ ト の 衝突 処理 方 法 を 示す 。 

M2) 図 2 は 、 本 発明 の 別 の 実施 形態 に に る ロボ ッ ト の 衝突 処理 方 法 を 示す 。 

図 3 】 図 3 は 、 本 発明 の 別 の 実施 形態 に に る ヒュ ー マ ノ イド ロボ ッ ト ERT. 

図 4 】 図 4 は 、 図 1 に 示し た 方 法 の 詳細 な 抜粋 を 示す 。 

図 5 】 図 5 は 、 図 2 の 方 法 の 別 の 説明 を 示す 。 

発明 を 実施 する た め の 形 態 】 

0065] 

図 1 は 、 少 な く と も 1 つの 運動 連鎖 を 含む 運動 連鎖 構造 を 有する ロボ ッ ト 1 の 衝突 処理 
方 法 を 示し 、 運 動 連鎖 構造 は 、 ベー ス 、 リ ンク 、 リ ンク を 接続 する 関節 、 ア クチ ュ エ ー タ 
お よび 少な く と も 1 つの エン ド エ フ ェ ク タ 、 カ トル ク を 測定 推定 する た め 少 な く と も 

1 つの 運動 連鎖 の 最も 遠 位 の リン ク に ある セン サ gar お よび 固有 受容 デー タ を 測定 
推定 する た め の セ ン サ 5, で 構成 され 、 セ ン サ S は 、 運 動 連鎖 構造 に 沿っ て 任意 に 配置 
きれ 、 こ の 方 法 は 、 

= ロボ ッ ト 1 の ダイ ナミ クス を 記述 する モデ ル を 提供 S 1 し 、 

少な く と も 1 つの 運動 連鎖 の 最も 遠 位 の リン ク で 、 セ ン サ Suista.i で カト ルク 
zzsgsegr を 測定 お よび また は 推定 S 2 L. 

- セン サ SO に より 固有 受容 デー タ : ベー ス お よび ロボ ッ ト の 一 般 化 座標 7() お よび そ 
れ ら の 時 間 微 分 9()、 一 般 化 関節 モー ター カ て r。、 外 力 廊 、 ベ ー ス 方 位 ps(D り お よび ベー ス 速 
度 *(0』、 を 測定 お よび プ ま た は 推定 S 3 L. 

- 固有 受容 デー タタ お よび モデ ル の 少な く と も 1 つ に 基づい て 、 運 動 量 オブ ザー バ 3 で 
一 般 化 外力 て の 推定 値 そ を を 生成 S 4 L. 

- そお よび て r,。 に 基づい て 、 ベ ー ス お よび ロボ ッ ト の 一 般 化 座標 9( ひ の 2 次 導 関 数 の 推定 
値 90 を 生成 S 5 L. 

- 0 に 基づい て 、 運 動 連 鎖 構 造 上 の 点 の の デカ ルト 加速 度 妃 を 推定 S 6 L. 

- 推定 外部 レン チ Fezesi を 取得 する た め 、 編 に 基づく 剛体 力学 効果 お よび 重力 効果 に 対 
L Chemie S TL, 

- 予期 し な い 衝 突 か ら 生 じ る 一 般 化 関節 力 の 推定 frpcor を 取得 する た め 、 ヤ コピ ビア ン 
太志 ai 次 換 さ れ た た zsagratz に 対し て を を 補正 8S 8 L. BEU, 

= Text cot > て Teresp お よび / また IX Eos si > Fsithresh の 場合 、 与え D Xxvi- BÀ E Tenresn dS d OS 
Fs ithresn に 基づい て 衝突 を 検出 する S 9 、 

ステ ッ プ を 含む 。 
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x 2 は 、 少 な く と も 1 つの 運動 連 鎖 を 含む 運動 連鎖 構造 を 有する ロボ ッ ト 1 の 衝突 処理 
方 法 を 示し 、 運 動 連鎖 構造 は 、 ベー ス 、 リ ンク 、 リ ンク を 接続 する 関節 、 ア クチ ュ エ ー タ 
お よび 少な く と も 1 つの エン ド エ フ ェ ク タ 、 カ トル ク を 測定 推定 する た め 少 な く と も 
1 つの 運動 連鎖 の 最も 遠 位 の リン ク に ある セン サ Sua /、 お よび 固有 受容 デー タ を 測定 
グズ 推定 する た め の セ ン サ 5%, で 構成 され 、 セ ン サ S は 、 運 動 連鎖 構造 に 沿っ て 任意 に 配 1 
され 、 こ の 方 法 は 、 

- ロボ ッ ト 1 の ダイ ナミ クス を 記述 する モデ ル を 提供 S 1 し 、 

- 少な く と も 1 つの 運動 連鎖 の 最も 境 位 の リン ク で 、 セ モ センサ Susia で カブ トル ク 
Fexesaistari を 測定 お よび また は 推定 S 2 L. 

- セン サ S に より 固有 受容 デ 一 タ : ベー ス お よび ロボ ッ ト の 一 般 化 座 標 9) お よび そ 
れ ら の 時 間 微 分 9( り 、 RO MC 
度 *( り Og、 を 測定 お よび ググ ま た は 推定 S 3 L. 

- 固有 受容 デー タ お よび モデ ル の 少な く と も 1 つ に 基づい て 、 運 動 量 オプ ブザー ババ 3 で 
一 般 化 外力 tT 吉 の 推定 値 を を 生成 S 4 し 、 

- を お よび て 。 に 基づい て 、 ベ ー ス お よび ロボ ッ ト の 一 般 化 座標 9( ひ の 2 次 導 関 数 の 推定 
値 の を 生成 S 5 し 

OK 基づい て 、 M dee E の 点 の の デカ ルト 加速 度 入 を 推定 S 6 L. 

定 外部 レン ナル 。。, を 取得 る た め 、 あ に 基づく 剛体 力学 効果 お よび 重力 効果 に 対 
uo STI. 

- PHL MRP Æ L 2 — 2 E BB BB JJ O YE E tu 。。, を 取得 する た め 、 ヤ コ ビ ア ン 
Jista E VIE Fors ai a 18 Mt U し て を を 補正 S 8 し 、 お よび 、 

7 人 extcol > Tinresh お よび ググ また LF si > Fsitnresn? BE» HA TU T FR f Tinresn 33 E U 
Fsithresn- Hs OV’) CMRE RES 9 し 、 

- 衝突 の ヵ 。 = (SH) mC. HORA -AR/IL fl ERAL, BLOHORARL 
運動 連鎖 構造 の ジオ メト リ を 交差 させ る こと で 、 運 動 連鎖 構造 と の 衝突 の 接触 位置 な を 決 
定 S 1 0 し 、 

- 決定 され た 接触 位置 々 に 基づい て 、 完 全 な 接触 ヤ コ ビ アン ル た ,= ル ん 誠 を 決定 S 1 1 し 


? 


fms 


- 外部 レン チ i (Flare Flean) vedi) Vt t aE S 1 2 し 、 お よび 、 

- re K UE Keen に 依存 する ロボ ッ ト を 制御 S 1 3 する 、 

ステ ッ ャ プ を 含む 。 
[0067] 

図 3 は 、 ベ ー ス 万 と 運動 連鎖 と し て の 腕 と 脚 を 備え た ヒュ ー マ ノ イド ロボ ッ ト 1 を 示し 
š oe ベー ス 速 度 は *() ぉ で ボボ され る 。 ヒ ュー マ ノ イ ドロ ボッ ト 
は 、 複 数 の 接触 状態 に 。 一 般 化 外力 ん は 、 そ の 構造 全体 に 作用 し て いる 。 a 
か る 力 は 移動 に 起因 し 、 da d は 操作 に 起因 する 。 他 の 外力 は 、 不 要 な 衝突 に 
て 引き 起こ され る 。 ま た 、 多 数 の カン トル クセ ン サ 5$, (B| 3 の 場合 は 5 つ ) は 、 PI 
1 の 運動 連鎖 構造 に 沿っ て 任意 に 配置 され て いる 。 2 つの 接触 が 右腕 で 検出 され る 。 1 つ 
NM 『 後 に あり 、 も う 1 つの 接触 が $。 と $』 の 間 に あ る 限り 、 ひ と つ は セン サ 5。 に 

よる も の 、 も う ひ と つ は セン サ 5』 に よる も の で ある 。 INF k UE, BETE 
る た め 、 こ れ ら 2 つの レン チ は 正しく 推定 され る 。 (それ 以 外 の 場合 、 望 まし い 手 順 は 式 
(2 8) で 示さ れる )。 
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刻 4 は 、 図 1 に 示し た 方 法 の 詳細 な 抜粋 を 示し て いる 。 式 CA) の 観測 され た 一 般 化 関 
節 力 か ら の 、 カ トル クセ モ センサ 5 に よっ て 測定 され た 遠 位 リン クル ん skarr で の 外部 レン 
チ の 除外 は 、 上 記 の 概要 で 行わ れる 。 し た が っ て 、 こ れ ら の レン チ は 、 上 記 の 概要 か ら 式 
(19) に 従っ て 補正 され 、 オ ブザー バ 3 か ら 反 gu と 9 を 受信 し て いる 四角 に 象徴 さ 
れる 負荷 補償 で 抗 』i か らん sar へ の マッ プ を 可能 に する 。 他 の すべ て の 表記 法 と 手 
順 は 、 図 1 に 対応 する 記述 の 下 で 説明 され て いる 。 反 gag を 出力 する 右上 の 点線 の ブロ 
ッ ク は フィ ルター で ある 。 


【0069】 

図 5 は 、 図 2 で 説明 し た ステ ッ プ の 異な る 図 を 示し 、 衝 突 検 出 の 分 離 お よび 識別 アル ゴ 
リズ ム の 概要 を 示す 。 し た が っ て 、 図 2 の 説明 で 参照 され る すべ て の ステ ッ プ S 1 .….S 1 
3 は 、 図 5 に も 適用 で きる 。 さ ら に 、 上 記 の 概要 、 特 に 式 (1 7 ) —& (19) が 適用 で 
RA, 使用 され る 感知 また は 推定 また は 生成 され た 情報 が 多い ほど 、 衝 突 検出 か ら よ り 多 
く の 情 報 を 取得 で きる 。 衝突 検出 が て 。。。。, の み に 基 づい て いる 場合 、 接 触 の 位置 を 十分 に 
突き 止め る こと は で き な い 。 太 rs: が さら に 使用 され る 場合 、 接 触 位置 は 、 検 出 セ ン サ と 
次 の セン サ の 間 に あ る ロボ ッ ト の 部 品 に 特定 で きる 。 完全 な 太 4。, が 使用 可能 な 場合 、 リ 
ンク ご と に 衝突 検出 を 実行 で きる 。 


符号 の 説明 】 

0070) 

: ロボ ッ ト 

オプ ザー ラバ 

: 提供 

: 測定 お よび また は 推定 
: 測定 お よび プ ま た は 推定 
: 生成 

: 生成 

: 推定 

: 補正 

: 補正 

検 出 
: 決定 
: 決定 
: 決定 
: 制御 
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